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1 .  INTRODUCTION 


An  effective  method  of  formulating  and  solving  differential  equations  of 
motion  for  general  mechanical  systems  subject  to  holonomic  constraints  has 
recently  been  presented  [1,2,3].  For  planar  systems,  a  three  vector  of 
Cartesian  generalized  coordinates  is  defined  for  each  rigid  body  of  the 
system.  Standard  and  user-supplied  constraints  are  formulated,  yielding 
algebraic  relations  Involving  generalized  coordinates  of  the  bodies  connected 
by  each  joint.  A  Lagrange  multiplier  technique  allows  coupling  of  the  alge¬ 
braic  constraint  equations  and  differential  equations,  yielding  a  large  system 
of  differential  and  algebraic  equations  which  are  solved  iteratively  using 
implicit  numerical  integration  methods  [1,2,3].  Because  of  weak  constraint 
equation  coupling,  the  Jacobian  matrix  associated  with  the  implicit  numerical 
Integration  method  is  sparse,  and  sparse  matrix  algorithms  are  effectively 
employed  to  gain  computational  efficiency  [4].  However,  implicit  numerical 
integration  methods  applied  to  mixed  systems  of  differential  and  algebraic 
equations  lead  to  numerical  difficulties  associated  with  badly  conditioned 
matrices  and  artificially  stiff  problems  [5]. 

.  Numerical  difficulties  associated  with  stiffness  of  equations  have  to 
some  extent  been  circumvented  in  other  methods  of  equation  formulation  by  re¬ 
placing  the  Cartesian  coordinates  with  a  smaller  set  of  Lagrangian  coordi¬ 
nates,  equal  in  number  to  the  constrained  system  degrees  of  freedom  [6,7,8]. 
Loop  closure  or  related  methods  are  used  to  formulate  constraint  relations, 
yielding  a  smaller  number  of  highly  coupled  differential  equations.  This  is 
desirable  from  a  numerical  integration  standpoint  and  leads  to  effective  com¬ 
puter  programs.  However,  depending  upon  the  set  of  Lagrangian  coordinates 
selected  and  the  method  of  constraint  formulation,  it  is  difficult  to  incor¬ 
porate  nonstandard  user-supplied  constraints.  Provision  for  user-supplied 
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constraints  thus  leads  to  increased  complexity  in  general-purpose  computer 
programs.  It  is  apparent  that  there  is  a  trade-off  between  program  generality 
in  the  first  approach  and  program  efficiency  in  the  second.  * 

A  generalized  coordinate  partitioning  method  presented  in  reference  9 
retains  desirable  features  of  both  of  the  above  methods:  (1)  the  simple 
constraint  formulation  of  the  first  in  terms  of  Cartesian  coordinates,  and  (2) 
the  minimal  system  of  differential  equations  of  motion  of  the  second,  equal  in 
number  to  the  constrained  system  degrees  of  freedom.  Excess  coordinates  are 
eliminated  numerically,  rather  than  analytically  in  the  second  method  above. 

Gaussian  elimination  with  full  pivoting  and  subsequent  L-U  factorization  [10] 
is  applied  to  the  Jacobian  matrix  of  the  constraint  equations  to  determine: 

(1)  the  number  of  system  degrees  of  freedom  [11,12],  (2)  partitioning  of 

It 

generalized  coordinates  into  independent  and  dependent  sets,  and  (3) 

construction  of  an  Influence  coefficient  matrix  expressing  dependent  * 

velocities  in  terms  of  independent  velocities  [6,  13,  14].  This  method 
incorporates  the  desirable  numerical  stability  properties  of  Gaussian 
elimination  with  full  pivoting;  that  is  associated  with  the  resulting  L  and  U 
matrices  [15].  The  numerical  advantages  of  this  approach  have  been 
demonstrated  from  a  kinematic  point  of  view  in  references  16  and  17.  The 
generalized  coordinate  partitioning  method  was  employed  to  develop  a  computer 
code  for  the  solution  of  dynamic  response  of  planar  mechanical  systems. 

Numerical  results  have  demonstrated  improved  computational  efficiency  and 
superiority  of  the  method  over  the  previously  developed  codes. 

In  this  report,  the  generalized  coordinate  partitioning  method  is  applied 
to  determine  the  dynamic  response  of  three-dimensional  mechanical  systems. 

Cartesian  generalized  coordinates  define  the  translational  degrees  of  freedom 
of  each  rigid  body. 


3 


In  a  preliminary  formulation  and  code  development  of  three-dimensional 
rigid-body  mechanics,  Euler  angles  were  employed  to  define  rotational  degrees 
of  freedom.  The  computer  code  was  used  to  determine  the  dynamic  response  of  a 
variety  of  three-dimensional  mechanisms.  A  significant  reduction  in  computer 
execution  time  was  demonstrated  in  all  of  the  simulations,  using  the  general¬ 
ized  coordinate  partitioning  method.  However,  the  use  of  Euler  angles  often 
causes  numerical  difficulties  when  one  or  more  of  the  rigid  bodies  experience 
large  rotations.  In  particular,  when  the  second  Euler  rotation  angle  is  equal 
to  kir  (k  =  0,1,2,...),  the  axes  of  the  first  and  third  rotation  angles  coin¬ 
cide,  so  these  two  angles  cannot  be  uniquely  determined.  Therefore,  some  con¬ 
straint  equations  become  dependent  at  that  instant  and  a  unique  solution  does 
not  exist.  A  method  to  circumvent  this  problem  is  to  monitor  the  row  rank  of 
the  constraint  Jacobian  matrix.  The  matrix  loses  rank  when  the  second  Euler 
rotation  angles  approach  kir.  Before  this  occurs,  the  computation  can  be 
interrupted  and  the  body  fixed  coordinate  systems  rotated  to  new  positions. 
This  technique  can  be  performed  automatically  by  the  algorithm.  However,  it  is 
time-consuming  and  in  general  cannot  be  done  easily.  The  above  feature  is  an 
inherent  problem  of  Euler  angle  representation  and  cannot  be  eliminated  com¬ 
pletely.  Euler  parameters,  in  contrast  to  Euler  angles  or  any  other  set  of 
three-rotational  generalized  coordinates,  have  no  critical  singular  cases 
[17],  thus  they  are  attractive  for  formulating  system  constraint  and  differ¬ 
ential  equations  of  motion  in  this  respect. 

2.  GENERALIZED  COORDINATE  PARTITIONING 

Denote  the  vector  of  generalized  coordinate  of  body  i  by  q  ;  q  =  [x,  y, 

,T 

z,  e  ,  e  ,  e  ,  e  J  ,  and  the  composite  vector  of  all  system  generalized 


T  T  T  T 

coordinate  by  q  =  Iq  ,q  ,...,q  I  ,  where  n  is  the  number  of  rigid  bodies  and  T 

-1  -2  -n 

denotes  vector  or  matrix  transpose.  In  this  notation,  holonomlc  constraint 
equations  can  be  written  in  vector  function  form  as 


^(q;!)  =  0 


(2.1) 


where  ®(q;t)  =  [$  (q;t),<I>  (q;t),...,0  (q;t)]  are  assumed  to  be  independent. 
-  1-  2-  m- 

The  Jacobian  matrix  for  Eq.  (2.1)  is  defined  as 


3$  3$ 


-'I  ^  ■  3q^ 


(2.2) 


and  has  full  row  rank.  Differentiation  of  Eq.  (2.1)  with  respect  to  time 
gives  the  kinematic  velocity  equation 


$  q  +  $  =0 

-q-  -t 


(2.3) 


Gauss-Jordan  reduction  of  the  matrix  ^  with  full  pivoting  obtains  a 

~q 

“  T  T  T 

partitioning  of  '!>  =  ['i’  ,^  ]  and  q  =  [u  ,v  ]  ,  where  u  and  v  are  the  vectors 

-q  -u  -V  -  _  _  _  _ 

of  dependent  and  independent  coordinates  respectively,  such  that  is  the 

-u 

nonsingular  submatrix  of  $  whose  columns  correspond  to  elements  u  of  q  and  ^ 

-q  _  _  _v 

is  the  submatrix  of  whose  columns  correspond  to  elements  v  of  q  [9].  Eq. 

-q  -  - 

(2.3)  can  be  written  in  partitioned  form  as 


u  +  $  V  = 

-u-  -V-  -t 

Since  $  is  nonsingular, 
-u 


.  -1  .  -1  .  -1 
U  =  — $  $  =  JJY  _  $  $ 

-  -u  -V-  -u  -t  -  -u  -t 


(2.4) 


The  system  equations  of  motion  can  be  expressed  as  [9] 


M(q)q  =  g(q,q;t)  -  $^(q;t)X 


(2.5) 


where  M(q)  is  the  system  mass  matrix,  g(q,q;t)  is  the  vector  of  modified 
generalized  forces  (refer  to  Eqs.  (5.6)  through  (5.10)),  and  A  is  a  vector  of 
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Lagrange  multipliers.  Partitioning  Eq.  (2.5)  according  to  u  and  v  yields 


uu"  uv"  u  T 

M  u+M  v=g  -OX  (2.6) 

-  -  -  -u- 


vu"  w“  V  T 

Mu+Mv=g-0X  (2.7) 

-  -  -  -V- 

T 

By  eliminating  ^  from  Eqs.  (2.6)  and  (2.7),  since  0  is  nonsingular,  it  can  be 

-u 

found  that 

vv  T  uv."  ,  vu  T  uu."  V  T  u 
[M  +HM  )v+(m  +HM  )u  =  g  +  Hg  (2.8) 


Differentiation  and  partitioning  of  Eq.  (2.3)  yields 


u=Hv-$  [(0q)q+20q+0  ]  (2.9) 

u  q-  q-  -tq-  -tt 


Equation  (2.5)  can  thus  be  reduced  to  a  system  of  second-order  differential 


equations  explicitly  in  terms  of  the  independent  generalized  coordinates  v. 


In  order  to  express  Eq.  (2.9)  in  first  order  form,  define  the  vector  s  of 


independent  velocities  as 

V  =  s  (2.10) 

The  velocities  q,  in  terms  of  s,  using  Eq.  (2.4),  can  be  written  as 


,  vu  T  uu.  -1 r .  T 

(m  +HM  ]$  [(OwJw+20  w+0  ]  (2.12) 

-u  -q-  q-  “tq-  “tt 

Equations  (2.10)  and  (2.12)  form  a  set  of  the  first-order  differential  equations 
for  the  independent  generalized  coordinates  v  and  velocities  s.  All  terms  in 
Eq.  (2.3)  are  determined  as  functions  of  v  and  s  through  the  constraint  equations 
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of  Eq.  (2.1)  and  Eq.  (2.11).  Solution  of  this  system  yields  the  complete 
system  state,  including  Lagrange  multipliers  if  constraint  reaction  forces 
are  desired. 

3.  GENERALIZED  COORDINATES  FOR  THE  ANGULAR  ORIENTATION  OF  A  RIGID  BODY 
In  order  to  specify  the  angular  orientation  of  a  rigid  body  in  an 
Inertial  (global)  coordinate  system  xyz,  it  is  sufficient  to  specify  the 
angular  orientation  of  a  coordinate  system  that  is  rigidly  attached  to 
the  body.  In  this  paper,  coordinate  rotations  defined  by  Euler  parameters 
are  discussed  and  employed  in  the  following  formulation. 

3.1  Transformation  Matrix 

Let  the  coordinate  system  5  D  ?  be  attached  to  body  i  as  shown  in  Fig. 

ill 

3.1,  where  the  origin  0  is  located  at  its  center  of  mass  (CM).  A  point  P  on 

1  i 

body  i  is  located  in  the  inertial  coordinate  system  xyz  by 

P  P  (3.1) 

r  =  r  +  A  s* 

-1  -i  i-  i 


P  r  P  P  PJ 

where  s’  =  15  »  U  ,  ?  I  are  the  coordinates  of  P  in  the  ?  h  ?  coordinate 
—  i  i  i  i  i  i 

system,  r  =  [x,  y,  z]T  are  the  coordinates  of  0  in  the  xyz  coordinate  system, 
-i  i  i 

and  A  is  the  rotational  transformation  matrix  of  body  i.  Matrix  A  ,  expressed 
i  i 

in  terms  of  Euler  parameters  e,e,e,e,is 

0  12  3 


-2  2 

e  +  e  -1/2 
0  1 


A  =  2  ee  +ee 
i  12  0  3 


e  e  -  e  e 

1-13  0  2 


e  e  -  e  e 
12  0  3 

2  2 

e  +  e  -  1/2 
0  2 


e  e  +  e  e 
2  3  0  1 


e  e  +  e  e 
13  0  2 


e  e  -  e  e 
2  3  0  1 

2  2 

e  -1  e  -  1/2 
0  3  J  i 


(3.2) 


where  subscript  i  indicates  transformation  matrix  for  body  i  [17].  The  four 
Euler  parameters  are  required  to  satisfy  the  equation 


7 


2  T  2  2  2  2 

e  +ee  =  e  +e  +e  +e  =1 
0  -  -  0  1  2  3 


(3.3) 


The  parameters  e  =  [e  ,  e  ,  e  ]  are  the  x,  y,  z  or  n,  ?  projections  of  a 
-  1  2  3 

vector  e  lying  on  the  axis  of  Instantaneous  rotation,  as  shovm  in  Fig.  3.2, 


and  e  is  defined  by 


->■  -»• 

e  =  u  sin  _X 
2 


(3.4) 


where  u  is  a  unit  vector  on  the  axis  of  rotation  and  y  is  the  angle  of 

rotation.  The  fourth  parameter  e  is  given  by 

0 

,  e  =  cos  X 

0  2 

It  should  be  noted  that  the  constraint  equations  (2.1)  include  Eqs.  (3.3)  for 
all  of  the  n  rigid  bodies. 

4.  CONSTRAINT  EQUATIONS 

Standard  constraints  between  rigid  bodies  are  taken  as  friction  free 
(workless)  joints.  Formulations  for  five  types  of  constraints  are  presented 
here  as  follows : 

Spherical  Joint :  Figure  4.1  shows  two  adjacent  bodies  1  and  j  connected 
by  a  spherical  joint  (ball  joint).  A  vector  loop  equation  can  be  written  as 


r  +s  -s  -r  =0  (4.1) 

1  i  j  j 

The  scalar  equations  for  this  joint,  determined  by  the  use  of  Eq.  (3.1),  are 

.P  .P 

r  +  As  -r  -  As  =  0 
-i  i-i  -j  j-j  - 


(4.2) 


Revolute  Joint;  Figure  4.2  depicts  a  revolute  joint  between  bodies  i 


and  j.  Point  P  is  common  to  both  bodies  and  points  Q  and  Q  are  located  on 

i  J 

bodies  i  and  j,  respectively  defining  the  axis  of  rotation  of  the  joint. 

Scalar  Eq.  (4.2)  holds  for  this  joint,  since  point  P  simply  acts  as  a  sperical 
joint.  Additional  constraints  are  obtained  by  requiring  the  cross  product  of 
vectors  g  and  g  to  be  zero,  which  forces  the  points  P,  Q  ,  and  Q  to  be  on  a 

^  ^  1  J 

common  line.  Vectors  g  and  g  can  be  expressed  in  component  form  as 

i  j 


T  T 

g  =  [u,v,w]  and  g  =  [u,v,w]  respectively  where 

“i  i  -j  J 


Q  P 

g,  =  A  (s’  -  s’  )  ;  k  =  i,  j 

-k  k  -  k  -  k 


(4.3) 


Then,  the  cross  product  of  g  and  g  ,  set  equal  to  zero,  yields  three  scalar 

^  j 

equations 

g  g  =  0  (4.4) 

-i  -j  - 


where  g^  is  a  skew-symmetric  matrix  containing  the  components  of 
defined  as 


g.  > 
-1 


V  ■ 

u 

o  . 

i 

From  the  three  equations  of  Eq.  (4.4),  only  two  are  independent.  The  best  two 
should  be  selected,  with  Eq.  (4.2),  to  form  five  constraint  equations  for  the 
revolute  joint.  To  avoid  numerical  difficulties,  proper  selection  of 
equations  from  Eq.  (4.4)  is  important,  particularly  when  the  joint  axis  is 
parallel  to  one  of  the  global  axes.  For  example,  when  the  joint  axis  is 
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parallel  to  the  z  axis,  the  first  equation  of  (4.4)  yields  zero  entries  in  the 
corresponding  row  of  the  Jacobian  matrix,  reducing  its  rank.  The  second  and 
third  equations  would  be  selected  in  this  case.  A  technique  for  selection  of 
the  proper  equations  is: 


compare  the  absolute  values  of  u  ,  v  ,  and  w  (or  u  ,  v  ,  and  w  ) 

i  i  i  j  j  j 

and  select  the  two  equations  having  the  largest  terms. 


Universal  Joint:  A  universal  joint  between  bodies  i  and  j  is  shown  in 

Fig.  4.3.  Since  point  P  is  common  to  both  bodies,  constraint  Eqs.  (4.2) 

again  apply  to  this  joint.  The  remaining  constraint  is  that  the  two  vectors 
■y  -y 

g  and  g  remain  perpendicular,  thus  their  dot  product  is  set  to  zero,  i.e. 

i  ,  j 


g  g  =  0  (4.5) 

-i  -j 


Cylindrical  Joint:  A  cylindrical  joint  forces  two  bodies  i  and  j  to  move 
along  a  common  axis.  Four  points.  Pi,  qj  ^ody  i  and  P j ,  Qj  on  body  j,  are 

->■  -V 

to  lie  on  the  same  axis  as  shown  in  Fig.  4.4.  The  vectors  g  and  g  of  constant 

^  i  j 

magnitudes  and  g^^  of  variable  magnitude  are  required  to  remain  collinear. 
Therefore,  the  constraint  equations  defining  a  cylindrical  joint  can  be 
found  from  two  cross  products 


g  g_  =  0  (4.6) 

-i  -J 


g  g  =0  (4.7) 

-i  -ij 

where  two  equations  from  Eqs.  (4.6)  and  two  from  Eqs.  (4.7)  should  be  selected 
based  on  the  technique  described  for  the  revolute  joint. 


Translational  (Prismatic)  Joint;  A  translational  joint  is  similar  to  a 
cylindrical  joint,  with  the  exception  that  the  two  bodies  cannot  rotate  rela¬ 
tive  to  each  other.  Therefore,  the  cylindrical  joint  equations  must  hold  and 
one  additional  equation  is  required.  Two  vectors,  h^  and  h^  on  bodies  i  and  j 
as  shown  in  Fig.  4.5,  are  to  be  perpendicular,  so 


h  h  =0 

-i-j 


(4.8) 


5.  RIGID  BODY  DYNAMICS 

T 

For  body  i,  let  m*  =  [m  ,  oi  ,  oi  ]  be  the  projection  of  the  angular  velo- 
-i  5  n  ?  i  ^ 

city  vector  on  the  local  coordinates  axes,  r  =  [x  ,  y  ,  z  ]  be  the  global 

—1  i 

location  of  the  center  of  mass,  m  be  the  mass  and  I  ,  I  ,  I  ,  I  ,  I  ,  I 

i  nn  ??  5n  n;; 

be  the  moments  and  products  of  inertia  about  the  5  ,  h  ,  C  axes.  The  kinetic 

i  i  i 

energy  of  the  ith  body  can  be  written  as 


.T  .  T 

T  =  l.r  Jr  +  lu'  iw’ 
i  2  -i  i-i  2  -i  i-i 


(5.1) 


where 


m  0 


=  0  m 


0  0 


I  =  I 
i 


I 

1 

r\K 

Tin 

n? 

a 

Angular  velocity  in  terms  of  Euler  parameters  can  be  expressed  as  [17] 


0)*  =  2B  p 
-i  i-i 


(5.2) 


(5.3) 


Eqs.  (5.6)  and  (5.7)  can  be  written  as 
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M  q  =  g  -  $  X 

-i 


(5.9) 


r  T  T  T  T 

where  q  =  ,p  J  =  [x,  y,  z,  e  ,  e  ,  e  ,  e  J  .  The  total  system 
-1--1  0123i 

equations  of  motion  for  n  rigid  bodies  is  then 

T 

Mq  =  g  -  $  X  (5.10) 

T  T  T  T 

Where  M  s  diag.  [m  ,  M  ,  ...,  M  J,  g  s  [g  ,  g  ,  g  J  and 

12  n  -  -1  -2  -n 

T  T  T,T 

9  =  Lq, »  ••• »  9  J  •  It  should  be  noted  that  Eq.  (5.10)  defines  the 

-  -1  -2  -n 

equations  of  motion  of  Eq.  (2.5). 

6.  FORCES 

Internal  forces  acting  between  bodies  may  be  obtained  by  a  process  similar 
to  the  constraint  equation  development.  For  example,  since  springs,  dampers, 
and  actuators  generally  appear  together,  as  shown  in  Fig.  6.1,  they  are  incor¬ 
porated  into  a  single  set  of  equations  [1].  Let  the  global  coordinates  of 

T 

the  attachment  points  be  r  =  [u,v,wj  ,  k  =  l,j.  The  length  of  the  spring— 

""Ic  Ic 

damper-actuator  is  thus 


[(u  -  u]  +(v  -  v)  +(w  -  w)] 

j  i'  "  j  i'  ^  j  i^  ■' 


(6.1) 


and  the  time  rate  of  change  in  spring  length  is 


r  /  *  •  • 

A=l(u  -u}(u  -u)+(v  -v)(v  -vl 

j  i  j  i  j  i  j  i 

•  • 

+(w  -w)(w  -wl]/o 
i  i  3  1 


(6.2) 
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The  magnitude  of  the  spring-damper-actuator  force  is  then  written  as 

f  =  k(A  -  +  cl  +  a  (6.3) 

o 

where  H  is  the  undeformed  length  of  the  spring  and  k,  c,  and  a  are  the  spring 
constant,  damping  coefficient,  and  actuator  force,  respectively.  The  compo¬ 
nents  of  spring-damper-actuator  force  in  the  global  coordinate  system  can  be 
determined  from 

^  ;  k,m  =  i,j  and  k  +  m  (6.4) 

*“K.  “K  Dl 

When  the  spring-damper-actuator  force  does  not  act  through  the  center  of  mass 
of  the  attached  bodies ,  torque  components  for  each  body  can  be  calculated  from 


h'  =  r'  A  f  ;  k  =  l,i 
-k  -k  k  -k 


(6.5) 


where  h'  is  the  vector  of  components  of  torque  about  C  ,  h  ,  5  axes. 

-k  k  k  k  ^ 

Transformation  of  the  components  of  the  torque  h'  =  [h  ,  h  ,  h  J  to 

T  -i  5  n  c  i 

h*  =  [h  ,  h  ,  h  ,  h  J  can  be  obtained  by  multiplying  both  sides  of  Eq.  (5.2) 

^  ei  e2  e3  i 

T 

by  h*^  to  get 


T  T 

h'  0)’  =  2  h’  B  p 
“i  -i  -i  -i-i 


(6.6) 


The  instantaneous  power  h*  o)'  is  independent  of  coordinate  system 

-i  -i 

T  T. 

representation,  so  h'  =  h  p  and  Eq.  (6.6)  becomes 

-i  -i  -i-i 


h  =  2B  h’ 
-i  i-i 


(6.7) 
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Substitution  of  Eq.  (6.5)  into  Eq.  (6.7)  yields 


T~  T 

h  =  2B  r’  A  f  ;  k  =  i,j 
~k  k“k  k~k 


(6.8) 


Similar  to  the  translational  spring-damper-actuator,  torsional  spring- 

damper-actuator  elements  may  be  defined  between  adjacent  bodies  1  and  j  that  are 

connected  by  a  revolute  joint,  as  shown  in  Fig.  6.2.  Two  vectors,  s  and  s  , 

i  3 

embedded  in  bodies  i  and  j  respectively,  define  a  plane  perpendicular  to  the 

revolute  joint  axes.  In  addition,  the  two  vectors  define  the  torsional  spring 

attachment  points  on  the  two  bodies.  The  angle  between  s  and  s  is  denoted 

i  3 

by  6  and  is  initially  assumed  to  be  0  <  0  <  tt.  Angle  6  can  be  calculated 
from  the  equation 


-1  s,  s. 
®  "J 

\t  |.|l 


0  <  6  <  TT 


(6.9) 


To  determine  all  possible  values  of  9,  a  point  K  is  initially  defined  on  the 
revolute  joint  axis  such  that  the  direction  of  vector  s  is  determined  by  the 
right  hand  screw  law  rotating  from  s  to  s  and  sweeping  angle  0  (initially 
0  <  9  <  ir).  During  the  dynamic  analysis,  the  cross  product  of  s  and  s  yields 
a  vector  parallel  to  s,  having  the  same  direction  if  0  <  0  <  tr,  and  opposite 
direction  if  tt  <  0  <  2Tr,  i.e.; 


T~ 

s  s  s 

-  -i-j 


>  0  ;  0  <  9  <  TT 


<  0  ;  TT  <  9  <  Zti) 


(6.10) 
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The  torque  of  a  torsional  spring-damper-actuator  element  can  be  calculated 
from 

h  =  k  (0  -  6°)  +  cO  +  a  (6.11) 

t 

o 

where  k,  c,  a  ,  and  0  are  the  torsional  spring  stiffness,  damping  coefficient, 
t 

actuator  torque,  and  undeformed  angle  of  the  element,  respectively.  If  the 

->• 

components  of  a  unit  vector  u  located  on  the  revolute  joint  axis  are  u'  and  u', 

*"i  “j 

expressed  in  body  i  and  body  j  coordinate  systems,  respectively,  the  components 
of  torque  expressed  in  these  coordinate  systems  is 

h’  =  hu'  ;  k  =  i,j  (6.12) 

“k  ~k 

Thus  the  generalized  torques  corresponding  to  the  Euler  parameters  coordinates 
can  be  determined  by  employing  Eq.  (6.7). 

6.1  Friction  [20] 

The  characteristics  of  sliding  or  Coulomb  friction  obtained  from  a  simple 

experiment  shown  in  Fig.  6.3  are  illustrated  in  Fig.  6.4.  In  Fig.  6.4,  P  and 

s 

y  represent  the  static  and  kinetic  coefficients  of  friction  respective.  If 

k 

the  absolute  value  of  the  applied  force  P  on  the  body  is  less  than  y  N,  where  N 

s 

is  the  normal  force,  the  friction  force  may  vary  from  zero  to  y  N.  In  this 

s 

case  the  magnitude  of  friction  force  should  be  determined  from  an  equation  of 

static  equilibrium.  When  the  absolute  value  of  P  is  greater  than  y  N,  the 

s 

friction  force  is  y  N  which  is  relatively  constant  until  a  high  velocity  is 

k 

reached. 

The  friction  force  expressed  in  terms  of  relative  displacement  is  a  step 
function  as  shown  in  Fig.  6.5.  In  the  case  of  no  relative  displacement  between 
the  two  bodies,  friction  force  may  vary  from  -yN  to  yN.  To  find  the  magnitude 
of  friction  force  in  this  case,  assume  a  shear  deformation  without  relative 
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displacement.  If  the  proportional  constant  between  shear  deformation  and  shear 
force  is  given,  the  shear  force  may  be  obtained  from  the  shear  deformation.  By 
taking  the  smaller  of  shear  force  or  friction  force,  the  magnitude  of  friction 
force  can  be  determined. 

To  find  the  direction  of  friction  force,  the  relative  velocity,  v  ,  between 

r 

the  two  bodies  at  the  point  of  contact  is  determined.  The  friction  force  can 
be  obtained  from: 

V 

r 

F  =  min(F  ,  F  )  Tiri 
f  f  s  r 

where  F  =  pN  and  F  is  the  shear  force.  Since  the  friction  force  acts  along 
f  s 

the  body  surfaces  and  its  line  of  action  does  not  generally  pass  through  the 
center  of  mass  of  the  body,  the  moment  components  due  to  this  force  must  also 
be  considered.  For  this  purpose  an  equation  similar  to  Eq.  6.8  can  be  applied. 

7.  DADS- 3-D  COMPUTER  PROGRAM 

A  general-purpose  computer  program.  Dynamic  Analysis  and  Design  System 
for  analysis  of  three-dimensional  mechanisms  (DADS-3-D),  has  been  developed, 
using  the  algebraic  equations  of  constraint  and  differential  equations  of 
motion  described  in  the  preceding  sections.  All  of  the  algebraic  and 
differential  equations  are  automatically  assembled  by  the  program  from  the 
input  data  describing  the  system.  Additional  nonstandard  constraints  and 
differential  equations  can  be  provided  through  user-supplied  subroutines. 

Since  interpretation  of  Euler  parameters  is  difficult,  input  data  can  be 
expressed  in  terms  of  Euler  angles  or  direction  cosines. 

The  use  of  the  Cartesian  and  Euler  parameter  generalized  coordinates 
yields  a  maximal  set  of  loosely  coupled  nonlinear  holonomic  constraints  and 
differential  equations  of  motion.  A  Gaussian  elimination  algorithm  with  full 
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pivoting  [10]  decomposes  the  constraint  Jacobian  matrix  and  identifies  depen¬ 
dent  and  independent  generalized  coordinates.  The  constraint  Jacobian  matrix 
in  general  is  sparse,  thus  the  algorithm  provides  the  necessary  information  to 
establish  a  modified  sparse  matrix  relating  variations  in  dependent  and  inde¬ 
pendent  variables.  This  process  eliminates  the  need  for  carrying  out  products 
of  sparse  matrices.  This  information  is  then  employed  to  identify  a  minimal 
system  of  the  second-order  differential  equations  of  motion  equal  in  number  to 
system  degrees  of  freedom.  The  second-order  differential  equations  of  motion 
are  reduced  to  the  first-order  form  by  a  change  of  variable  and  solved  by  the 
predictor/corrector  numerical  integration  algorithm  DE/STEP/INTRP  [18].  The 
algorithm  numerically  integrates  the  differential  equations  for  independent 
generalized  coordinates  and  extrapolates  the  remaining  equations  for  the 
dependent  generalized  coordinates.  At  each  step,  integration  error  is 
evaluated  and  time  step  and  integration  order  are  adjusted  accordingly  [18]. 

The  generalized  coordinate  partitioning  technique  and  the  predictor/  cor- 
eector  numerical  integration  method  have  demonstrated  improved  efficiency  over 
a  previously  developed  computer  code.  However,  the  major  contribution  of  this 
investigation  is  application  of  Euler  parameters  to  circumvent  singularity 
problems  and  enhance  program  efficiency.  The  user  manual  for  DADS-3-D  code  is 
provided  in  Appendix  F. 

8.  THREE-DIMENSIONAL  MODEL  OF  TRACKED  VEHICLES 

The  DADS-3-D  code  is  employed  to  simulate  a  highly  nonlinear  multiple 
degree-of-freedom  vehicular  system.  Figure  8.1  depicts  a  computer-generated 
three-dimensional  model  of  a  26  degree-of-freedom  tracked  vehicle  with  five 
roadwheels  per  side.  The  transient  response  of  the  vehicle  to  a  large  weapon 
firing  impulse  is  desired.  Figure  8.2  illustrates  the  side  view  of  the  model 
in  detail.  The  model  consists  of  17  rigid  bodies.  Bodies  1  to  10  represent 
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roadwheels.  Bodies  11  and  12  are  the  chassis  and  turret  respectively.  These 
two  bodies  are  connected  by  a  vertical  revolute  joint.  Body  13  models  the  re¬ 
coiling  and  nonrecoiling  parts  of  the  gun.  A  second  revolute  joint  between 
bodies  12  and  13  models  the  trunion  centerline.  Bodies  14  to  17  represent 
road  arms  connecting  the  front  and  rear  roadwheels  to  the  chassis  with  revo¬ 
lute  joints.  These  bodies  are  introduced  for  the  convenience  of  connecting 
shock  absorbers  between  road  arms  and  chassis.  The  remaining  six  roadwheels 
are  attached  to  the  chassis  using  massless  links  with  revolute  joints  at  the 
ends . 

The  vehicle  has  a  torsion  bar  suspension  system.  Translational  spring- 
damper-actuators  1  to  10  are  employed  to  incorporate  the  nonlinear  suspension 
characteristics,  including  jounce  stops.  Figure  8.3  illustrates  typical 
force-displacement  suspension  characteristics.  This  force  displacement  rela¬ 
tion  as  well  as  other  nonlinear  functions  are  incorporated  into  the  model  from 
discrete  data  points.  Actuators  11  to  14  implement  the  damping  characteristics 
of  Fig.  8.4.  Springs  15  to  26  simulate  two  pretentioned  tracks  connecting 
the  drive  sprockets  and  roadwheels.  These  nonlinear  springs  do  not  support 
compression. 

Additional  generalized  forces  are  introduced  to  represent  roadwheel- 
ground  interaction.  These  nonlinear  functions  allow  the  wheels  to  leave  the 
ground  and  include  damping.  Frictional  forces  proportional  to  the  normal  com¬ 
ponent  of  the  wheel-ground  reaction  oppose  tangential  displacement  at  the 
point  of  contact. 

8.1  Platform  Stability  Analysis 

The  vehicle  is  allowed  to  achieve  an  equilibrium  configuration  prior  to 
initiating  transient  analysis.  Prior  to  firing,  two  additional  constraints 
are  applied  to  lock  the  relative  rotational  degrees-of-freedom  between  the 
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turret-chassis  and  the  gun-turret.  A  force  with  an  impulse  of  3851  Ibs.s 
(139300  lbs.  lasting  0.02765  s),  that  simulates  recoil  due  to  firing  the 
main  weapon,  is  applied  to  the  model  along  the  gun  barrel  centerline. 

First  simulation  is  performed  for  forward-firing  of  the  gun.  The  gun  is 
initially  horizontal.  Friction  model  includes  only  the  coulomb  friction. 
Appendix  A  presents  the  response  plots  for  this  simulation.  A  peak 
longitudinal  acceleration  of  3.25  g’s  is  reached.  Maximum  longitudinal  dis¬ 
placement  of  the  chassis  is  3  in.,  where  approximately  1.5  in.  is  due  to 
sliding.  The  chassis  pitches  about  4°,  while  the  maximum  lift  of  the  front 
wheels  is  7  in. 

The  gun  is  rotated  45®  horizontally  for  the  second  simulation.  The 
response  plots  are  given  in  Appendix  B.  The  longitudinal  and  lateral  peak 
accelerations  are  2.33  g's  and  2.22  g*s  respectively.  The  maximum  pitch, 
roll,  and  yaw  angles  are  3.2®,  3.0®,  and  1.7®  respectively.  The  plot  of  the 
yaw  angle  versus  time  reveals  the  yaw  rotation  does  not  recover,  i.e.,  the 
vehicle  comes  to  rest  with  1.7®  rotation  about  the  vertical  axis  from  its 
original  orientation.  Longitudinal  and  lateral  displacement  curves  of  the 
chassis  show  that  the  c.g.  of  the  chassis  has  moved  3  in.  longitudinally  and 
2.8  in.  laterally. 

Response  plots  of  a  side  fire  simulation  are  given  in  Appendix  C.  A  peak 
lateral  acceleration  of  3.25  g's  has  been  achieved  for  the  chassis.  The 
lateral  displacement  curve  of  the  chassis  indicates  5.5  in.  of  sliding. 

The  maximum  roll  angle  is  4®  and  a  non-recoverable  yaw  of  1.5®  can  be 
observed.  The  yaw  rotation  is  the  result  of  the  impulse  line  of  action  not 
crossing  the  vertical  line  which  passes  through  the  combined  c.g.  of  the 


vehicle 
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Two  additional  simulations  for  the  45°  Impulse  and  side  fire  have  been 
made.  The  response  plots  are  presented  in  Appendices  D  and  E.  The  major 
difference  between  these  two  models  and  previous  models  is  the  inclusion  of 
ground-track  shear  deformation  in  the  friction  model.  These  simulations  show 
that  the  shear  deformation  model  introduces  high-frequency  components  in  the 
system  (stiff  system),  therefore  the  CPU  time  increases  drastically.  The 
responses  shown  in  Appendices  D  and  E  should  not  be  compared  with  the  plots  of 
Appendices  B  and  C,  because  some  of  the  inertial  characteristics  of  the  models 
are  different. 

8.2  Elevation  and  Azimuth  Stabilization 

In  order  to  test  the  nonstandard  element  capability  (user-supplied 
equations)  of  the  DADS-3-D  code,  an  additional  set  of  differential  equations  is 
formulated  and  solved  along  with  the  mechanical  system  differential  equations. 
This  set  of  additional  differential  equations  models  two  stabilization  systems 
for  elevation  and  azimuth  controls.  The  basic  structure  of  the  elevation  and 
azimuth  control  systems  is  identical,  and  Fig.  8.5  shows  the  schematics  of  one 
of  the  two  control  systems  [21].  The  input  to  the  control  system  is  the  gunner’s 
command  on  the  desired  angle,  with  the  additional  feedback  input  from  the  gun 
angular  position  and  velocity.  Each  control  system,  containing  an  electro- 
hydraulic  servocontrol  device,  generates  a  torque  output  which  is  applied  to 
change  the  angular  position  of  the  gun  in  elevation  or  azimuth.  Figure  8.6 
shows  the  responses  of  a  simulation  of  the  vehicle  with  two-axis  controller  to 
the  gunner’s  command  to  readjust  the  elevation  angle  of  the  gun  from  its 
initial  position.  Readjustment  of  the  azimuth  angle  to  the  gunner’s  command  is 
illustrated  in  Fig.  8.7.  Figure  8.8  shows  the  response  of  simultaneous  change 
in  elevation  and  azimuth  angles  with  the  two-axis  controller. 
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Figure  4,1  Spherical  Joint  Between  Two  Rigid  Bodies 


Figure  4,2 


Revolute  Joint 


Figure  4.3  Universal  Joint 


Figure  4.4  Cylindrical  Joint 
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Figure  4.5  Translational  Joint 


Figure  6,1  Translational  Spring-Damper-Actuator  Element 
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Figure  6.2  Torsional  Spring'-Damper-Actuator  Element 


Piston  Velocity  (IN/SEC) 


Figure  8.4  Suspension  damping  characteristic  for  the  M551 


Figure  8.5  Control  system  diagram  for  gun  elevation  or  azimuth 


stabilization 


ri551-152MM  GUN'S  CONTROLLER 


TIME  (SECONDS) 

ELEVATION  OF  GUN 
(  GUNNER'S  COMMAND  :  10  DEGREE 
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Appendix  A 

Response  Plots  for  Platform  Stability  Analysis 
Forward-Fire  Simulation 


*  Coulomb  friction 

*  coefficient  of  friction  =  0.5 

*  1.0  second  simulation 

*  CPU  time  on  PRIME  -  750  «  7000  sec. 
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Appendix  B 

Response  Plots  for  Platform  Stability  Analysis 
45“  Fire  Simulation 


*  Coulomb  friction 

*  Coefficient  of  friction  =  0.5 

*  1.0  second  simulation 

*  CPU  time  on  PRIME  -  750  “  6500  sec. 
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Appendix  C 

Response  Plots  for  Platform  Stability  Analysis 
Side  Fire  Simulation 
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*  Coulomb  friction 

*  Coefficient  of  friction  =  0.5 

*  1.0  second  simulation 

*  CPU  time  on  PRIME  -  750  «  5800  sec. 
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Appendix  D 

Response  Plots  for  Platform  Stability  Analysis 
45“  Fire  Simulation 


*  Output  time  Internal  =  0.0025 

*  Coulomb  friction 

*  Ground-track  shear  deformation  (ref.  point:  bottom  of  the  wheels) 

*  Coefficient  of  friction  = 

*  1.0  second  of  simulation 

*  CPU  time  on  PRIME  -  750  «  9  hr. 
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Appendix  E 

Response  Plots  for  Platform  Stability  Analysis 
Side-Fire  Simulation 


*  Output  time  interval  =  0.005 

*  Coulomb  friction 

*  Ground-track  shear  deformation  (ref.  point: 

*  Coefficient  of  friction  = 

*  1.0  second  of  simulation 

*  CPU  time  on  PRIME  -  750  “  6.5  hr. 
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User  Manual 
DADS-3D 

Input  Data  Structure 
and  Format 
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PART  ONE 


Data  Input  to  DADS-3D 
Revised  May  13,  1981 


The  order  in  which  the  following  segments  apoear  is  arbitrary  and  need 
not  be  followed  by  the  user. 

There  are  three  commands  which  may  be  inserted  in  the  data*  These  are 
LIST,  NOLIST,  and  END.  LIST  and  NOLIST  can  be  used  anywhere  in  the  data 
set  (between  segments),  as  often  as  you  wish.  Anything  after  a  LIST 
command  is  printed  in  the  output  until  a  NOLIST  command  is  encountered 
(default  is  NOLIST).  The  END  statement  must  appear  at  the  end  of  each  data 
set  • 

I.  Problem  Output  Label 

II.  System  Information 

III.  Rigid  Body* 

IV.  Initial  Condition* 

V.  Constraint 

VI.  Spherical  Joint 

VII.  Universal  Joint 

VIII.  Revolute  Joint 

IX.  Cylindrical  Joint 

X.  TranslationalJoint 

XI.  MasslessLink 

XII.  TransLational-Spring-Damper~ Actuator 

XIII.  Torsional-Spring- Damper-Actuator 

XIV.  Pointer 

XV.  Spline  Function 

XVI.  END  Card* 

The  input  segments  with  a  *  cannot  be  eliminated  from  the  input.  The 
elimination  of  other  segments  depends  on  the  problem  type. 

Each  segment  starts  with  an  identifier  card.  There  are  two  entries  on 
every  identifier  card.  The  first  entry  contains  four  Letters  in  columns 
1-4,,  describing  the  type  of  the  segment,  e.g.,  HEAD,  SYST,  PODY,  etc.  The 
second  entry,  an  integer  number  in  columns  5-8,  specifies  the  number  of 
cards  or  group  of  cards  to  be  followed  in  that  segment. 
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REMARKS 


<1)  In  this  manual*  all  integer  variable  names  begin  with  one  of  the  four 
letters:N»J*T*orK. 


N:  An  inteaer  variable  beginning  with  N  indicates  a  "total  number 

of,..". 


J:  An  integer  variable  beginning  with  J  indicates  an  index;  1.e.* 

Jxxxx  =  1 • 2  * . • . « Nx X XX . 


l;  An  integer  variable  beginning  with  I  indicates  a  flag  in  order  to 
enable  or  disable  some  actions  in  the  program. 


K:  An  integer  variable  beginning  with  K  indicates  card  number. 

(2)  All  integer  entries  should  be  right  justified. 

(3)  vihere  the  range  of  an  index  is  given  by  J  =  the  cards  should 

be  placed  consecutively  according  to  J. 

(4)  Where  the  range  of  an  index  is  given  by  1<J<N*  the  cards  do  not  need  to 
be  placed  in  consecutive  order, 

(5)  Statements  with  a  #  indicate  the  nonapplicability  of  that  option  in  the 
present  version  of  the  program. 

(6)  X*Y*?  indicates  global  coordinate  system  and  x*y*7.  indicates  local 
coordinate  system. 
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I.  PROBLEM  OUTPUT  LABEL 
Identifier  Card  (A4*  14) 


Notes 

Co  Lumns 

Variable 

Entry 

1-4 

5-8 

HEADER 

NCARDS 

HEAD 

Number  of  cards  for  the 

descr ipti on 

pro  bl em 

Headi nq 

Card  (s ) 

(20A4> 

Notes 

Columns 

Variable 

Entry 

1-80 

LABEL  (20) 

Enter  the  heading  information  on 
cards*  This  heading  will  be 
with  the  output  as  label 

NCARDS 
pri nted 

II 


SYSTEM  INFORMATIOM 
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idg.ntif  is 

r  Card 

(  A4 

♦  14) 

Motes 

Column 

1  s 

Variable 

(1) 

1  - 

4 

HEADER 

(1) 

B 

NSYST 

System  Card(s) 

Card  i: 

(314, 

8X, 

bFlO  .0  > 

Notes 

Columns 

Variable 

4 

K1 

Entry 

SYST 

Mumber  of  systsm  cards 

Entry 

Enter  1  if  this  card  is  used 


Q. 

lUMlT 

12 

I  ANGLE 

16 

I  ANAL 

21  -  30 

GC 

31  -  40 

GRC 

41  -  50 

GLX 

51  -  60 

GLY 

61  -  70 

GLZ 

Identifies  the  system  of  units  emoLoyed 
to  the  oroblem 

E3.0?  SI  units  (Default  value) 

EQ.l  ;  slug-feet  units 

E'5«2.;  sLug-irich  units  (mixed  units*  not 
recommended ) 

EG*o;  all  inojt  angles  in  radians 
(Default  unit) 

EQ.i;  all  input  angles  in  degrees  (The 
orogram  will  convert  them  to  radians) 
Flag  that  controls  the  type  of  analysis 
EQ.O;  static  equilibrium  and  dynamic 
analysis  (default) 

EO.i;  data  check  only 
EG •2?  static  equilibrium  only 
EQ»5»  dynamic  analysis  only 
Gravitational  constant.  Default  value 
is  1.0 

Ratio  of  q/gc.  Default  value! 

GRC  =  9.8066*  IF  lUNTT.EQ.O 

GRC  =  32.174  *  IF  lUtJIT.EQ.l 
Ratio  of  the  projection  of  the 

gravitational  field  vector  on  the  global 
X-axis  to  its  magnitude  gx/g  (-1  <  GLX  < 
1).  Default  value  is  0.0 
Ratio  of  the  projection  of  the 

gravitational  field  vector  on  the  global 
Y-axis  to  its  magnitude  gy/g  (-1  <  GLY  < 
1 ). 

Ratio  of  the  projection  of  the 

gravitational  field  vector  on  the  global 
Z-axis  to  its  magnitude  gz/g  (-1  <  GL7  < 
1).  Default  value  is  -1.0*  and  also 
(GLX)**2-*-(GLY)**2+(GLZ)**2=1.0  must  be 
satisfied. 


Card  2: 
Notes 


Card  3: 
Notes 


(14,  8X,  14,  4X,  2F10.0,  20X,  2F10.0) 
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Columns  Variable  Entry 

4  K2  Enter2ifthiscardis(jr>ed 

16  INTRF  EQ.O;  forces  a  solution  at  the  desired 

reporting  intervals  designated  by  COMINT 

and  controll1n3  stepsize  H, 

EQ.i;  interpolate  the  state  vector  to 

the  desired  reporting  intervals 

designated  by  COMI.NT 

EQ.2;  interpolate  both  the  state  vector 
and  its  first  time  derivative  to  the 
desired  reporting  intervals  design  a ted 
by  COM  I  NT 


21  -  30 

COMINT 

Reporting  interval  during  simulation. 

Default  value  is  0.05 

31  -  40 

TEND 

Final  value  of  the  independent  variable 
TIME.  Default  value  is  1.0 

61  -  70 

HMAX 

Maximum  step  size  allowed.  Default 

value  is  0.001 

71  -  80 

TSTART 

Starting  value  of  the  independent 

variable  TIME.  Default  value  is  0.0 

(414,  4X, 

FIO.O) 

Columns 

Variable 

Entry 

4 

K3 

Enter  3  i f  t h i s  c a rd  i s  u se d 

8 

ILISTJ  ti 

Flag  which  controls  a  sytfibolic  listing 
of  the  Jacobian  matrix  for  debugging 

12 


IRF  # 


16 


I  ST  ART  # 


purposes ; 

E0*0;  no  list  (Default  value) 

EQ.li  print  symbolic  listing  each  time 
structure  of  the  Jacobian  matrix  changes 
and  execute  the  program 

EQ.2;  print  symbolic  listing  for 
assemble  phase  only  and  terminate 
execution 

Flag  which  directs  the  program  to  save 
all  data  necessary  to  restart  a 
simulation  in  the  event  of  termination 
nrior  to  completion; 

E  Q . 0  ;  do  not  save  (Default  value) 

EO.i;  save 

Flag  that  selects  the  method  of  starting 
(or  restarting)  the  integration; 

EQ.O;  all  first  time  derivatives  are 
assumed  to  t)e  zero  (Default  value) 

FO.-i;  all  time  derivatives  fjre  assumed 
to  have  been  defined 

GC.l  end  LF.b'  the  program  assumes  that 
this  is  a  recovery  from  earlier  run. 


21 


30 


EPS 


Relative  local  error  tolerance 
value  is  C.OOl 


nef aut  t 


NOTES 

(1)  This  segment  cannot  be  eliminated.  It  the  default  values  for  the 
parameters  on  the  1»  2*  and  3  cards  are  desired*  ttic'n  NSYST  should  foe 
set  to  zero  and  no  other  cards  should  follow  the  identifier  for  ;this 
segment. 
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RIGID  BODY 
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I^SUllliSC-Csrd  14) 


Notes 

C  0  Lump  s 

Variable 

Entry 

1  -  4 

HEADER 

BODY 

(1) 

Rigid 

5  ”  B 

Body  Card(s) 

NB 

Number  of  rigid  bodies  <Including  the 
ground) 

Card 

i:  <514,  2F10. 

0) 

Notes 

CoLumns 

Variable 

Entry 

(2) 

1  -  4 

J 

Rigid  body  number*  1,2, •••,NB 

8 

K1 

Enter  i;  card  1  of  a  set  of  three  cards 

(3) 

9-12 

JFX  « 

Integer  subscript  of  a  vector  of  user 
supplied  force-time  functions  to  be 
entered  into  the  X-equations  of  motion 

(3) 

13  -  18 

JFY  # 

Integer  subscriot  of  a  vector  of  user 
supplied  force-time  functions  to  be 
entered  into  the  Y-equations  of  motion 

(3) 

17  -  20 

JFZ  n 

Integer  subscriot  of  a  vector  of  user 
supplied  force-time  functions  to  be 
entered  into  the  Z-eouations  of  motion 

21  -  30 

M 

HassoftheJthbody 

31  -  40 

WT 

Weight  of  the  Jth  body*  If  blank, 

WTrGRC*M. 

Card 

2:  <514,  6F10. 

0) 

Notes 

Columns 

Variable 

Entry 

(2) 

1-4 

J 

Rigid  body  number;  1,2,*..,NP) 

R 

K2 

Enter  2*  card  2  of  a  set  of  three  cards 

(5) 

9  -  12 

JTS  # 

Integer  subscriot  of  a  vector  of  user 
supplied  t 0 r que-t i me  functions  to  be 
entered  in  the  psi-direction 

(3) 

13  -  16 

JTP  it 

Integer  subscriot  of  a  vector  of  user 
supplied  t o r que-t i me  functions  to  be 
entered  in  the  phi-direction 

(3) 

17  -  20 

JTT  tt 

Integer  subscriot  of  a  vector  of  user 
supplied  torqje-time  functions  to  be 
entered  in  the  theta- direction 

(4) 

21  -  30 

JINX 

Moment  of  inertia  of  the  Jth  body  w.r.t. 
x-ax i s 

(4) 

31  -  40 

JINY 

Moment  of  inertia  of  the  Jth  body  w.r*t* 
y-ax i s 

(4) 

41  -  5  0 

JINZ 

Moment  of  inertia  of  the  Jth  body  w«r*t* 
2  -  a  X  i  s 

(4) 

51  -  6  0 

JINXY 

Product  of  inertia  of  the  Jth  bociy 

w.r.t.  V-  and  y-axis 

<4) 

61  -  70 

JINXZ 

f’roduct  of  Inertia  of  the  Jth  body 

w.r.t.  X-  and  z-axis 
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NOTES 

(1)  Three  cards  are  required  for  each  rigid  body*  /Therefore*  d*NB  cards 
shojld  follow  the  identifier  card* 

<2)  Rigid  bodies  should  be  numbered  consecutively  from  1  to  NB. 

(2)  X-T-Z  is  the  global  (ground)  coordinate  system  and  x-y-z  is  local 
(body)  coordinate  system  with  origin  at  the  center  of  mass*  The 
units  on  the  mass*  moment  of  inertia*  forces  and  weight  should  be 
comoatible  with  the  identifier  flag*  lUMIT*  on  system  information 
card  1.  (Refer  to  segment  IT). 

(-»)  JINXY  =  -INT(xy  dm) 

JINX  =  “INT(x**2  dm)  and  so  on. 
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IV.  INITIAL  CONDITION 


Identifier  Card  (A4»  lA) 


Notes 

Columns 

Variable 

Entry 

1  -  A 

HEADER 

ICON 

(1) 

5-8 

NB 

Number  of  initial  condition 

(should  be  equal  to  NB) 

cards 

Initial 

Condition 

Card(s> 

Card  i: 

(5IA»  6F10.0) 

- 

Notes 

Columns 

Variable 

Entry 

1-4 

J 

Rigid  body  number;  1»2*...*N3 

8 

K1 

Enter  1»  Card  1  of  a  set  of  two 

c  ar  ds 

12) 

12 

ICX 

EQ,  .0;  flags  variables  LIX  and 

X  as 

initial  estimates 

ES.l?  UX  and  X  are  taken  as 
conditions 

initial 

(2) 

1 6 

ICY 

EO.O;  UY  and  Y  are  taken  as 
est i mates 

initial 

EO.i;  UY  and  Y  are  taken  as 
condi ti ons 

initial 

(2) 

2  0 

ICZ 

EQ.o;  UZ  and  Z  are  taken  as 

ini ti a  1 

estimates 

EO.i;  UZ  and  Z  are  taken  as 

initial 

condi t Ions 

21  -  3  0  X  X-coordlnate  of  the  body  r.  .g.  relative 

to  the  global  coordinate  system 

31  -  AO  Y  Y-coordInate  of  the  body  c.g.  relative 

to  the  global  coordinate  system 

Al-50  Z  7-coordinate  of  the  body  c.q.  relative 

to  the  global  coordinate  system 

(3)  51  -  6a  ^SI  PsI -coo rd  1  na t e  of  the  body  c.g. 

relative  to  the  global  coordinate  system 

(3)  61  -  70  PHI  Ph 1 -coord  1 nat e  of  the  body  c.g. 

relative  to  the?  global  coordinate 
system. 

(3)  71-80  THFTA  Theta-coordinate  of  the  body  c.g. 

relative  to  th?  global  coordinate  system 


Card  2:  (5IA,  6F10.C) 


Notes 

Col umn  s 

Variab le 

Entry 

1-4 

J 

Rigid  body  number?  1»2»...«NB 

a 

K2 

Enter  2i  card  ?  of  a  set  of  two 

card  s 

(2) 

12 

ICR 

EO.C;  flags  variables  WS  and 

PSI  as 

initial  estimates 

EO.i;  WS  and  PSI  are  taken  as 
conditions 

ini  t:  i  a  1 

(2) 

16 

ICP 

ED.o;  flags  variaoles  WP  and 
initial  estimates 

PHI  as 
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20 

ICT 

21 

-  3  0 

ux 

31 

-  40 

UY 

41 

-  50 

UZ 

51 

-  60 

ws 

61 

-70 

WP 

71 

-  80 

UT 

E 3 •  1  *  U! P  and  ? H I  are  taken  as  i  n i  t  i  a L 
cond 1 t ions 

E Q •  0  ?  f  L a :;4 s  variables  W T  and  THETA  as 
Initial  estimates 

En,i;  WT  and  THETA  are  taken  as  Iriitial 
conditions 

Time  derivative  ot  x;  velocity  1n 

X -direction  at  TSTART 

Time  derivative  of  Y*  velocity  in 

Y-directlon  at  TSTART 

Time  derivative  of  Zl  velocity  in 

T-direction  at  TSTART 

Time  derivative  of  psi?  velocity  in 

Dsl-di reel  Ion  at  TSTART 

Time  derivative  of  phi;  velocity  in 

phi -direct  ion  at  TSTART 

Time  derivative  of  theta?  velocity  in 
ttieta-direction  at  TSTART 


NOTES 

(1)  Two  cards  are  required  for  each  rigid  body.  Therefore^  2* NO  cards 
shojld  follow  the  identifier  card. 

(2)  Initial  estimates  may  be  adjusted  by  the  program  to  satisfy  the 
constraint  equations  during  the  initial  asse mb  ly / s t a t i c  equilibrium 
step.  If  given  coordinates  are  not  to  be  changed  prior  to 
initialization  of  the  transient  analysis  steo*  they  should  be  flagged 
as  initial  conditions.  Care  should  be  taken  to  soecify  initial 
conditions  only  on  generalized  coordinates  that  are  free  to  change. 
The  general  rule  to  follow  is  that  if  any  of  the  existing  constraints 
will  determine  an  exact  initial  value  for  a  generalized  coordinate* 
then  it  should  not  be  flagged  as  an  initial  condition.  Specifying  an 
initial  condition  on  a  coordinate  causes  the  program  to  place  a 
constraint  on  that  degr ee-of-f reedom  during  the  initial  asseinbly 
process. 

(3)  Refer  to  Fig.  8. 1.2.1 
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V.  CONSTRAINT 

(AA*  I  A) 

Notes  Columns  Variable  Cntry 

1  -  A  HEADER  CSTR 

5-  8  NCR  Number  of  constraint  cards 


Const  raint_Cardis).  (A  14*  4X*  FIO.O) 


Notes 

Co lumn  s 

Variable 

Entry 

(1) 

1-4 

J 

Constraint 

number  ; 

1  <  J  <  NCR 

(2) 

5-8 

JCB 

Body  number 

of  the 

constrained 

va  ri ab le 

(2) 

9-12 

JCV 

Des i gnat  es 

the 

variable 

to  be 

constrained 

EO.i;  constrain  displacement  in 

X-direction*  X(JC8) 

EQ«2i  constrain  displacement  in 

Y-direction*  Y(JCB) 

E0.3;  constrain  displacement  in 

2-direction*  2(JCB) 

EQ»4;  constrain  displacement  in 

eO-direction*  eOlJCB) 

E0.5;  constrain  displacement  in 

el-direction*  eKJCB) 

E0»6;  constrain  displacement  in 

e2.-d  i  rec  t  i  on  *  e2(JCB> 

EQ.7t  constrain  displacement  in 

e3-di rect ion  *  s3(JCB) 

15-16  JCFK  EQ.O?  JCV  is  constrained  to  the 

constant  value  VAL 

GT»0»  Integer  subscript  of  a  vector  of 
user  supplied  function  of  time  to  which 
the  above  variable  JCV  will  be 
const  rained 

21  -  30  VAL  This  value  is  used  to  constrain  variable 

JCV  when  JCF  .FQ.  0 


NOTES 

(1)  The  functions  are  supplied  in  the  user  supplied  subroutine(s)»  The 
program  generates  the  necessary  constraint  equations  and  introduces 
Lagran(3e  multipliers.  Care  should  be  taken  to  insure  that  none  of 
the  existing  constraint  equations  are  Violated. 

(2)  A  rigid  body  may  have  none*  one*  or  more  than  one  constraint*  When  a 
rigid  body  has  no  constraints*  no  cards  should  be  supplied.  For 
rigid  bodies  with  mors  than  one  constraint*  more  than  one  card  is 
needed.  For  example*  if  the  Y  and  el  on  the  4th  rigid  body  are 
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constrained*  on  one  card  JCH=4,  JCV=?  and  on  another  card  dCB=4, 
JC\/  =  5  are  the  proper  settings. 

In  order  to  constrain  a  rigid  body  to  ground*  the  three 
translational  coordinates  and  iust  three  ot  the  four  Euler  oarameters 
should  be  constrained*  i.e.*  constraints  x*  y*  z*  el*  e2*  and  e3. 
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VI.  SPHERICAL  JOINT  (Type  1  Joint) 


1  dent  I f I e r 

Card  <  A4» 

14) 

Notes 

Columns 

Variable 

Entry 

1-4 

HEADER 

SPHR 

5  -  8 

MJl 

Number  of  Spherical  Joints 

Spherical  Joint  Card(s>  (14»  2IA*  AX»  6F10.0) 


Notes 

Co  Lumns 

Variable 

Entry 

1  - 

A 

J 

Spherical  Joint  number;  1»2». 

.. fNJl 

9  - 

12 

JlRJl 

One  of  the  two  body  numbers 
this  joint  (1<J13J1<NB) 

common  to 

13  - 

18 

J1BJ2 

The  other  body  number  common 

to  this 

joint  (1<J1BJ2<N3»  JIB J2/= J13 J1 ) 

(1) 

21  - 

30 

XJl 

X -coordinate  of  the  joint 
point  relative  to  body  JlRJl 

de  f i ni ti on 

(1) 

31  - 

40 

YJl 

y-coordinate  of  the  joint 
point  relative  to  body  JlBJl 

defini tion 

(1) 

41  - 

50 

ZJl 

z-coordinate  of  the  joint 
point  relative  to  body  JlBJl 

definition 

(1) 

51  - 

60 

XJ2 

x-coordinate  of  the  joint 
point  relative  to  body  J1BJ2 

defini tion 

(1) 

ol  - 

70 

YJ2 

y-coordinate  of  the  joint 
point  relative  to  body  J1BJ2 

definition 

(1) 

71  - 

8  0 

ZJ2 

2-coordinate  of  the  joint 
point  r e  1  a t  i  V to  body  J 1 P  J 2 

defini tion 

NOTES 

( 1 ) 

The  same 

point 

must  be  expressed  with  respect  to  lilfferent 

coordinate 

systems. 

Refer 

to  Fig. 

8 . 5 . 1  .  1  . 
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VTI.  UNIVERSAL  JOINT  (Type  ?  Joint) 


iden  t,iiie  r_Q^a  r  d  {AA»  14) 


Notes 

Columns 

Variable 

Entry 

(1) 

1-4 

5  -  ft 

HEADER 

NJ,? 

UNI  V 

Number  of  universal  joint 

Universal  .Joint  Cards 
Card  l:  (414,  4X,  6F10.0) 


Notes  Columns  Variable  Entry 


1 

4 

ft 

J 

K1 

Universal  joint  number;  1,2, 
Enter  i;  card  1  of  a  sot  of 

. . .  ,MJ2 

two  cards 

9 

12 

J2RJ1 

One  of  the  two  body  numbers 
this  joint  (1<J23J1<NB) 

common  to 

13 

mm 

16 

J23J2 

The  other  body  number  common  to  this 
joint  {1<J28J2CNB,  J23 J2/= J2BJ1 ) 

(2) 

21 

3  0 

XJl 

x-coordinate  of  the  joint 
point  relative  to  body  J2r>Jl 

defini tion 

C2) 

31 

4  0 

Y  J1 

y-coordinate  of  the  joint 
point  relative  to  body  J2PJ1 

defini  tion 

(2) 

41 

■* 

5CI 

2J1 

z-coordinate  of  the  joint 
point  relative  to  body  J2DJ1 

defini tion 

(2) 

51 

60 

X  J2 

x-coordinate  of  the  joint 
point  relative  to  body  J2BJ2 

definition 

(2) 

61 

““ 

70 

YJ2 

y-coord1nate  of  the  joint 
point  relative  to  body  J29J2 

defini tion 

(2) 

71 

• 

BO 

ZJ2 

z-coordinate  of  the  joint 
point  relative  to  body  J2BJ2 

defini tion 

Card  2: 

(214,  12X, 

6F10.0> 

Notes 

Columns 

Variable 

Ent  ry 

1  -  4 

J2 

Universal  joint 

number  »  1 

,NJ2 

B 

K2 

Enter  2X  card  2 

of  a  set 

of  two  cards 

(2) 

21  -  30 

ALPHJl 

x-coordinate  of 

the 

joint 

ax  i  s 

definition  point 

relative 

to  body 

J2BJ1 

(2) 

31  -  40 

BETAJl 

y-coordinate  bf 

the 

joint 

axis 

definition  point 

relative 

to  body 

J2BJ1 

(2) 

41  -  50 

GAMA J1 

z-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J2BJ1 

(2) 

51  -  60 

ALPHJ2 

x-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J2B  J2 

(2) 

61  -  7  0 

BETAJ2 

y-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J2BJ2 

(2) 

71  -  80 

GAMAJ2 

z-coordinate  of 

the 

joint 

ax  is 

definition  point 

relative 

to  body 

J2B  J2 
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:*  NOTES 

(1)  Two  cards  are  required  for  each  universal  joint.  Therefore» 

#  cards  should  follow  the  identifier  card. 

(2)  Refer  toFig.  8.5. 2.1. 


2*N  J2 
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Vin.  R^:\/0LLITE  JOIMT  (Tyoe  3  Joint) 

Identifier  Card  (A^t  14) 


Notes 

Columns 

Variable 

Entry 

1  -  4 

HEADER 

P.  V  L  T 

(1) 

5  -  8 

NJ3 

Number  of  resolute  joints 

R  e  V  0  Ui  t  e 

Joint  Cards 

Card  i:  (414,  4X,  6F10.D) 


Notes  Colutnns  Variable  Entry 


1 

4 

8 

J 

K1 

U rii  V e r s a  1  j  o i  n t  n u m b e r  ?  1,2, 
Enter  i;  card  1  of  a  set  of 

»  •  •  ,  N  J  3 

two  cards 

9 

12 

J3BJ1 

One  of  the  two  body  numbers 
this  joint  (1<J33J1<NP) 

common  to 

13 

•• 

16 

J3BJ2 

The  other  body  n u m t' e r  common  to  this 
joint  (1<J3BJ2<NB»  J3B J2/= J33 J1 ) 

(2) 

21 

* 

30 

XJl 

x-coordinate  of  the  joint 
point  relative  to  body  J3PJ1 

definition 

(2) 

51 

• 

40 

YJl 

y-coord1nate  of  the  joint 
point  relative  to  body  J3BJ1 

definition 

(2) 

41 

50 

ZJl 

z-coordinate  of  the  joint 
point  relative  to  body  J3:JJ1 

definition 

(2) 

51 

60 

XJ2 

x-coordinate  of  the  joint 
point  relative  to  body  J3BJ2 

definition 

(2) 

61 

•• 

7  0 

YJ2 

y-coordinate  of  the  joint 
point  relative  to  body  J3DJ2 

definition 

(2) 

71 

80 

2  J2 

z-coordinate  of  the  joint 
point  relative  to  body  J3BJ2 

definition 

Card  2:  (214,  12X,  6F10.0) 


Notes 

Columns 

Variable 

Entry 

1  -  4 

J 

Revolute  joint  number?  1,2,»,»,NJ3 

8 

K2 

Enter  2?  card  2 

of  a  set 

of  two  cards 

(2) 

21  -  30 

ALPHJl 

x-coordinate  of 

the 

joint 

axis 

definitior^  point 

relative 

to  body 

J3RJ1 

(2) 

31  -  40 

BETAJl 

y-coordinate  of 

t  he 

joint 

axis 

definition  point 

relative 

to  body 

J3BJ1 

(2) 

41  -  5  0 

GAMA J1 

z-coordinate  of 

the 

joint 

axis 

definition  point 

r  e  1  a  i  i  v  e 

to  body 

J3BJ1 

(2) 

51  -  60 

ALPHJ2 

x-coordinate  of 

the 

joint 

axis 

definition  point 

re  1  a  t i ve 

to  body 

J3BJ2 
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(2) 

SI  -  70 

BETAJ2 

(2) 

71  -  80 

GANAJ2 

/-coordinate  of  the  joint  axis 
definition  point  relative  to  body  J3BJ2 
z-coordinate  of  the  joint  axis 
definition  point  relative  to  body  J3Bd2 


NOTES 

(1)  Two  cards  are  required  for  each  revolute  joint*  Therefore*  2*NJ3 
cards  should  follow  the  identifier  card* 

(2)  Refer  to  Fig*  8. 5. 3*1. 
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IK.  CYLIl^DRICAL  JOim  (Type  H  Joint) 


Identifier 

Card  ( A4» 

I4> 

-4 

Notes 

Columns 

Variable 

Entry 

Ji 

T 

{ 1  > 

1  “  4 
b  -  8 

HCAOLR 

NJ4 

C  YLN 

Number  of  cylindrical  joints 

CyUndrlcal  Joint  Cards 

I 

Card  i:  (41^*  4K,  6F10.0) 

Notes  Columns  Variable  Entry 


1 

4 

8 

J 

K1 

Cylindrical  joint  number;  1 
Enter  i;  card  1  of  a  set  of 

*2.. ..»N  J4 

two  cards 

9 

— 

12 

J4BJ1 

One  of  the  two  body  numbers 
this  joint  <1<J4BJ1<NB) 

common  to 

13 

•• 

16 

J42J2 

The  other  body  number  common  to  this 
joint  (1<J4BJ?<NB»  J43 J2/= J4B J1 > 

(2) 

21 

30 

XJl 

x-coordinate  of  the  joint 
point  relative  to  body  J4B J 1 

defini tion 

(2) 

31 

— 

40 

YJl 

/-coordinate  of  the  joint 
point  relative  to  body  J4BJ1 

de  f ini ti on 

(2) 

41 

50 

2J1 

2-coordinate  of  the  joint 
point  relative  to  body  J4RJ1 

definition 

<2) 

51 

• 

60 

XJ2 

x-coordinate  of  the  joint 
point  relative  to  body  J48J2 

definition 

(2) 

61 

7  0 

YJ2 

y-coordinate  of  the  joint 
point  relative  to  body  J4BJ2 

defini  ti  on 

(2) 

71 

•• 

80 

ZJ2 

7-coordinate  of  the  joint 
point  relative  to  body  J4BJ2 

defini  ti  on 

Card  2:  (2I4,  1,?X,  r,F10.0) 


Notes 

Columns 

Variable 

Entry 

1  -  4 

J 

Cylindrical  joint 

number; 

1  ♦  2  »  •  •  . 

*N  J4 

8 

K2 

Enter  2*  card  2 

of  a  set 

of  two  cards 

♦ 

(2) 

21  -  30 

ALPHJl 

x-coordinate  of 

the 

joint 

axis 

definition  ooint 

relativi? 

to  body 

J4BJ1 

(2) 

31  -  40 

BETA J1 

y-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J4BJ1 

(2) 

41  -  50 

GAf^AJl 

2-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J4BJI 

(2) 

51  -  60 

ALPHJ2 

x-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  b  0  cJ  y 

J4BJ2 

(?) 

61  -  70 

BETAJ2 

y-coordinate  of 

the 

joint 

ax  i  s 

def Inition  point 

relative 

to  body 

J4BJ2 

(2) 

71  -  80 

GAMAJ2 

z~coordinate  of 

the 

joint 

(axis 

definition  point 

relative 

to  body 

JABJ2 

NOTES 

(1)  Two  cards  are  required  for  each  cyLindricaL  joint.  Therefcret  2*NJ4 
cards  should  follow  the  identifier  card. 


(2)  Refer  to  Fig.  R. 5.^.1 
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X*  TRANSLATIONAL  JOINT  (Type  5  Joint) 


T dent i f i er _C or d  (AA»  14) 


Notes 

Columns 

Variable 

Entry 

(1) 

1  -  4 

5-8 

HEADER 

N  J5 

THAN 

Number  of  t  r  .a  n  s  1  a  t  i  ona  1  joints 

Card  l:  (414,  4X,  6P10.0) 


Notes 

Columns 

Variable 

Entry 

1 

. 

4 

J 

T  rans  1  a  t  i  of)a  1  joint  number? 

1  ,2  ,•••  ,NK,i5 

8 

K1 

Enter  1 »  card  1  of  a  set  of 

three  cards 

9 

12 

J5RJ1 

One  of  the  two  body  numbers 
this  joint  (1<J5BJ1<NB) 

common  to 

13 

• 

16 

J5BJ2 

The  other  body  number  common  to  this 
joint  (I<J58J2CN3,  J5 R J 2/ = J 5B J 1 ) 

(2) 

21 

•• 

30 

XJl 

x-coordinate  of  the  joint 
point  relative  to  body  J50J1 

defini tion 

(2) 

31 

• 

40 

YJl 

y-coordinate  of  the  joint 
point  relative  to  body  J5BJ1 

de  f ini tion 

(2) 

41 

50 

ZJl 

z-coordinate  of  the  joint 
point  relative  to  body  J5PJ1 

defini tion 

(2) 

51 

60 

X  J2 

x-coordinate  of  the  joint 
point  relative  to  body  J5BJ2 

definition 

(2) 

61 

70 

YJ2 

y-coordinate  of  the  joint 
point  relative  to  Dody  J5BJ2 

de  f i ni 1 1  on 

(2) 

71 

80 

ZJ? 

z-coordinate  of  the  joint 
point  relative  to  body  J5RJ2 

defini  tion 

Card  ?:  (214,  12X,  6F10.0) 


Notes 

Co  lumns 

Variable 

Entry 

1-4 

J 

Translational  joint  number 

?  1,2,* 

•  •  ♦ N  J5 

a 

K2 

Enter  2*  card  2 

of  a  set 

of  three 

c  ar  ds 

(2) 

21  -  30 

ALPHJl 

x-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J5BJ1 

(2) 

31  -  40 

BETAJl 

y-coord(nate  of 

the 

joint 

ax  i  s 

t 

definition  point 

relative 

to  body 

J5B  J1 

(2) 

41  -  50 

GAMA J1 

z-coordinale  of 

the 

Joint 

axis 

definition  point 

relative 

to  body 

J5BJ1 

(2) 

51  -  6  0 

ALPHJ2 

x-coordinate  of 

the 

joint 

axis 

definition  point 

r  e  1  a  t  i  v  (? 

to  body 

J5B  J2 
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(2) 

hi  -  70 

3ETftJ2 

y-coordinate  of 

the 

i  0  i  n  t 

axis 

definition  point 

relative 

to  body 

J5B  J2 

(2) 

71  -  80 

GAMAJ2 

2-cob rd in ate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J5BJ2 

Card  3: 

Notes 

(21  A,  12X, 

Columns 

&F10.0) 

Variable 

Entry 

1  -  A  ■ 

J 

Translati ona 1 

joint 

number » 

1  ♦  2  » •  •  • 

tNJ5 

8 

K3 

Enter  3?  Card 

3  of 

a  set  of 

three  cards 

(2) 

21  -  30 

SX.  J1 

X -coordinate 
J5BJ1 

of 

a  point  relative  to 

body 

(2) 

31  -  AO 

SYJl 

y-coordinate 
body  dSBJl  . 

0  f 

the 

point 

relative 

to 

(2) 

A1  -  50 

SZ  J1 

2-coordinate 
body  J5BJ1 

of 

the 

point 

relative 

to 

<2) 

51  -  60 

SXJ2 

x-coordinate 
body  J5BJ2 

0  f 

the 

point 

relative 

to 

(2) 

61  -  70 

SY  J2 

y-coord inate 
body  d5BJ2 

of 

the 

point 

relative 

to 

(2) 

71  -  80 

SZJ2 

2-coordi nate 
body  J53J? 

0  f 

the 

point 

relative 

to 

NOTES 

(1) 

Three 
3*N  J5 

cards  are  required  for 
cards  should  follow  the 

each  translational  joint, 
identifier  card. 

Therefore* 

(2) 

Refer 

to  Fig*  3«5»5.1« 

HASSLES*^  LIf>lK  (Type  7  Joint) 


XI. 


Notes 

Co  1  urnn  s 

Variable 

Entry 

1  -  4 

HEADER 

LINK 

(1) 

5  -  R 

NJ7 

Number  oi  massless  lirtks 

Massless . 

^ink  Cards 

1 

Card  i: 

{4I4f  4X, 

6E10.0  ) 

Notes 

Columns 

Variable 

Entry 

1-4 

J 

Massless  link  number?  l,2f.*.,NJ7 

a 

K1 

Enter  1?  card  1  of  a  set  of  three  cards 

9-12 

J7BJ1 

One  of  the  two  body  numbers  common  to 
this  joint  (1<J7BJ1<ND) 

13  -  la 

J7BJ2 

The  other  body  number  common  to  this 
joint  (1<J7BJ2CN3,  J7B J2/= J7B J1 ) 

(2) 

21  -  3  0 

XJl 

x-coordinate  of  the  joint  definition 

point  relative  to  body  J7BJ1 

(2) 

31  -  40 

YJl 

y-coordinate  of  the  joint  definition 

point  relative  to  body  J7BJ1 

(2) 

41  -  5  0 

ZJl 

z-coordinate  of  the  joint  definition 

point  relative  to  body  J7BJ1 

(2) 

51  -  6  0 

XJ2 

x-coordinate  of  the  joint  definition 

point  relative  to  body  J7DJ2 

(2) 

51  -  7  0 

YJ2 

y-coordinate  of  the  joint  definition 

point  relative  to  body  J7RJ2 

(2) 

71  -  80 

ZJ2 

z-coordinate  of  the  joint  definition 

point  relative  to  body  J7EJ2 

Card  2: 

(414,  4X, 

6F10.0) 

Notes 

Columns 

Variable 

Entry 

1  -  4 

J 

Massless  link  number*  1,2,...,NJ7 

R 

K2 

Enter  2*  card  2  of  a  set  of  three  cards 

9-12 

LTl 

EO.i;  Joint  on  body  J7BJ1  is  a 

spherical  joint 

EQ.2t  Joint  on  body  J78J1  is  a  revoLute 
joint 

13  -  16 

LT2 

EQ.i;  Joint  on  body  J7BJ2  is  a 

spherical  joint 

EG.2;  Joint  on  body  J7BJ2  is  a  revoLute 
joint 
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(2) 

21  -  30 

ALPHJl 

x-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J7Bdl 

(2) 

31  -  40 

BETAJl 

y-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J7nJl 

(?) 

41  -  50 

GAMAJl 

z-coordinate  of 

the 

joint 

axis 

definition  point 

relat ive 

to  body 

J7BJ1 

(2) 

51  -  60 

ALPHJ2 

x-coordinate  of 

the 

joint 

axis 

definition  point 

relative 

to  body 

J7BJ2 

(2) 

61  -  70 

BETAJ2 

y-coordinate  of 

the 

joint 

ax  i  s 

definition  point 

relative 

to  body 

J7BJ2 

(2) 

71  -  80 

GAMA J2 

z-coo  rd i nate  of 

the 

joint 

axis 

def i ni t ion  point 

relative 

1 0  bo  dy 

J7BJ2 

Card  3: 

(314,  8X, 

6F10.0> 

Notes 

Co lumns 

Variable 

E  n  t  r  y 

1-4 

J 

Mass  1  ess 

link  number. 

1 

B 

K3 

Enter  3; 

Card  3  of  a 

set  of  three  cards 

9  -  1?  LTIJ  EQ»o;  Anqle  between  two  jo^nt  axes  of 

J7BJ1  and  J7BJ2  is  D  (requires  that 
SXJ2*  SYJ2»  and  S7J2  be  input) 

EQ*i;  Angle  between  joint  axes  of  J7BJ1 
and  J7BJ2  is  not  0  (input  THETIJ) 

21  -  30  LP  Length  of  link 


31  -  40 

THETl 

Angle  between  link  and 
J7PJ1 

Joint 

axis  of 

41  -  50 

THET2 

Angle  between  link  and 
J7aj2 

joint 

axis  of 

51  -  6  0 

THETIJ 

Angle  between  two  joint 
anc?  J7BJ2  (when  LTIJ=1) 

axes 

of  J7BJ1 

or  SXJ2 

x-coordinate  of  a  point 
J78J2  (when  LTIJ=0> 

on 

the  body 

61  -  70 

SYJ2 

y-coordinate  of  a  point 
J7BJ2 

on 

the  body 

71  -  8  0 

SZ  J2 

z-coordinate  of  a  point 

on 

the  body 

J7BJ2 


NOTES 

(1)  Three  cards  are  required  for  each  massless  link.  Therefore*  3*N<..!7 
cards  should  follow  the  identifier  card* 

(2)  Refer  to  Fig.  8.5. b.l. 
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XII. 

TRAMSLATIOMfiL- 

SPRIMG-DAMPcR 

-ACTUATOR 

Motes 

Columns 

Variable 

Entry 

1  -  A 

HEADER 

LSDA 

e 

(1  ) 

5  -  B 

MLSDA 

Number  of  t r a  ns  1  a t i ona 1 -so r i ng- damp er — 
actuator  elements 

Linear 

Sprlnq-Damoer 

-Actuator  Card(s) 

Card  1 ; 

(414*  4X, 

6F10.0) 

N  0 1  e  s 

Columns 

Variable 

Entry 

1-4 

J 

Element  nunit)er;  1*2*«..*  MLSDA 

ft 

K1 

Enter  i;  card  1  of  a  set  of  two  cards 

9-12 

JBSDJl 

One  of  the  two  body  numbers  common  to 
this  element  (  1<JBSDJ1<NR> 

13  -  1C 

J3CDJ2 

The  other  body  number  common  to  this 
element  (  1< JOSD J2<NB ♦  JBS D J2 /  =  JB SD J 1 ) 

(2) 

21  -  30 

X  J1 

x-component  of  the  point  where  the 

element  is  attached  to  body  JBSDJl 

relative  to  the  coordinate  system  of 
body  JBSDJl 

(2) 

31  -  40 

YJl 

y-component  of  the  point  where  the 

element  is  attached  to  body  JBSDJl 

relative  to  the  coordinate  system  of 
body  JBSOJl 

(2) 

41  -  50 

ZJl 

z-component  of  the  point  wheree  the 

element  is  attached  to  body  JBSDJl 

relative  to  the  coordinate  system  of 
body  JBSDJl 

(2) 

51  -  60 

XJ2 

x-component  of  the  point  where  the 

element  is  attached  to  body  JBSDJ2 

relative  to  the  coordinate  system  of 
body  JBSDJ2 

(2) 

61  -  70 

YJ2 

y-component  of  the  point  where  the 

element  is  attached  to  body  JBSDJ2 

relative  to  the  coordinate  system  of 
body  JBSDJ2 

<2) 

71  -  80 

ZJ2 

z-component  of  the  point  where  the 

element  is  attached  to  body  JBSDJ2 

relative  to  the  coordinate  system  of 
body  JBSDJ2 

Card  2: 

(514*  4F10 

.  0  > 

Notes 

Col umn  s 

Var  iab le 

Entry 

1  -  4 

J 

ELement  number;  1 » 2 * . • . * NLSD A  (same  as 
its  corresponding  number  on  card  1) 

8 

12 

Enter  2;  card  2  of  a  set  of  two  cards 

(3) 

9-12 

JAL  # 

Integer  subscript  in  a  vector  of  user 
supplied  function  of  time  which 
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specifies  the  actuator  Icnrjth  as  a 

f  unct  ion  of  title 

(3>  13  -  16  JAF  #  Integer  subscript  in  a  vector  of  user 

SUDD  lied  function  of  time  which 
specifies  the  actuator  force  as  a 
functionoftime 

17  -  20  JKL  Integer  subscript  of  spring 

characteristic  which  is  function  of 
deformation*  JKL=0  or  blank  means  the 


spring  is  Linear  with  spring 
SK. 

cons  tant 

21  -  30 

SK 

Element  spring  constant 

31  -  4Q 

D 

Element  damping  coefficient 

41  -  50 

snto 

Undeformed  element  length  <SDL0 

>0.0) 

51  -  60 

AF 

Actuator  force  applied  between 
attachment  points 

the  two 

NOTES 

(1)  Two  cards  are  required  for  each  translational-spring-damper-actuator. 
Therefore*  O^NLSDA  cards  should  follow  the  identifier  card. 

(2)  Refer  to  Fig.  9.3.2. 

(3)  These  features  allow  the  actuator  length  or  actuator  force  to  be 
designated  as  a  constant  value  or  function  of  time.  Both  JAF  and  JAL 
may  not  be  greater  than  zero  at  the  same  time* 
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X  III  .  TO^SIONAL-SPRING-DAMPFR-ACTUATOi^ 
Identifier  Card  (A4»  14) 


Notes 

Columns 

Variable 

Ent  ry 

1-4 

HL'ADER 

T8DA 

(1 ) 

5  -  B 

NTSDA 

N u m t) e r  of  torsional  spring  elements 

Torsional 

-Sorino- 

Oamoer-Actuator 

Ca r  d { s  ) 

Card  1 : 

{414*  4X 

»  6F10.0) 

Notes 

Columns 

Variable 

Ent  ry 

1  -  5 

J 

Element  number?  It NTSDA 

p, 

K1 

Enter  1?  Card  1  of  a  set  of  three  cards 

9-12 

JRVLT 

The  joint  number  about  which  this 

element  acts 

12  -  IG 

JT  J 

Tyoe  of  joint  bf  JRVLT 

ED*1?  Spherical  joint 

Ew.2?  Universal  joint 

EQ*3?  Re VO  lute  joint 

21  -  30 

X  JI 

x-coordinate  of  the  spring  attachment 
point  relative  to  the  first  body 

31  -  40 

YJl 

y-coordinate  of  the  spring  attachment 
point  relative  to  the  first  body 

41  -  50 

2J1 

z-coordinate  of  the  spring  attachment 
point  relative  to  the  first  body 

51  -  60 

X  J2 

x-coordinate  of  the  spring  attachment 
point  relative  to  the  second  body 

61  -  70 

YJ2 

y-coordinate  of  the  spring  attachment 
point  relative  to  the  second  body 

71  -  8  0 

ZJ2 

z-coordinate  of  the  spring  attachment 
Doint  relative  to  the  second  body 

Card  2:  (414*  4X* 

4F10.0 ) 

Notes 

Columns 

Variable 

Ent  ry 

1  -  4 

J2 

Element  number?  l»2»»»»tNTSDA  (J1=J2> 

8 

K2 

Enter  2?  Card  2  of  a  set  of  three  cards 

9-12 

JAT  If 

Integer  subscriot  in  a  vector  of  user 
supplied  functions  of  time  which 
specifies  the  actuator  torque  as  a 
function  of  time 

13  -  16 

JKT  U 

Integer  subscript  of  spring 
characteristic  which  is  function  of 
deformat  ion. 

EQ.O;  The  spring  is  Linear  with  spring 
constant  SKT 

21  -  30 

SKT 

Element  soring  constant 

31  -  40 

DT 

Element  damping  coefficient 

r 

■§ 


41  -  5  0 

AT 

51  -  60 

PHIO 

Card  3 : 

(3I4»  8X» 

3F10.0) 

Notes 

Columns 

Variable 

1  -  4 

B 

9-12 

J3 

K3 

JAL  8 

21  -  30 

SX  J1 

31-40  SYJl 

41  -  50  SZJl 


Actuator  torque  applied  be  tween  the  two 
rigid  bodies  aoout  the  revolute  joint 
Undeformed  angle  of  the  spring 


Entry 


Element  number?  1 t2t • • . » MTSDA  (J3=J1> 
Enter  3»  Card  3  of  a  set  of  three  cards 
Integer  subscript  in  a  vector  of  user 
supplied  function  of  time  which 

specifies  the  actuator  length  as  a 

function  fo  time 

x-coordinate  of  a  point  on  the  joint 
axis  with  resaect  to  the  first  body  to 
specify  spring  attachment  direction  by 
the  law  of  right  handed  screw  from  the 
first  body  to  the  second  body 
y-coordinate 
z-coordinate 


NOTES 


(1)  3*MTSDA  cards  should  follow  the  identifier  card 


XIV 


POINJTER 


Identiflijr  Card  (A4»  lA) 


Notes 

Columns 

Variable 

Entry 

(1) 

1  -  A 

HEADER 

PDTM 

5-8 

MPTS 

Number  of  pointers 

Pointer 

Card(s)  (214. 

12X,  3F1D.0) 

Motes 

Co  lumns 

Variable 

Entry 

1-4 

J 

Pointer  number;  1 . 2  .  .  .  .  ♦  fvPTS 

5-8 

JB 

R  1  g  i  d  t-  0  d  y  n  u  m  b  e  r 

21  -  30 

XU 

x-component  of  the  pointer  relative 
the  coordinate  system  of  body  JS 

t  0 

31  -  40 

ETA  J 

y-comnonent  of  the  pointer  relative 
the  coordinate  system  of  body  JB 

to 

41  -  50 

2T  A 

2-component  of  the  pointer  relative 

to 

the  coordinate  systeii  ot  body  JB 


MOTES 

(1)  This  segment  enables  the  user  to  request  for  outout  information  at 
specified  Location(s)  on  a  rigid  body.  The  position  of  a  pointer 
shojld  be  given  with  respect  to  the  rigid  body  coordinate  system. 


XV.  SPLINJF  FUWCTIOM 
Identifier  Card  (A4»  14) 


Notes 

Co  lumns 

Variable 

Entry 

1-4 

5  -  B 

HEADER 

NSPLN 

SPLN 

Number  of  spline  functions 

NSPLN  sets  of  cards  as  described  below  need  to  be  supplied  following  the 
identifier  card: 

3*  SEllQS_LtlQ£tl2D_iQf2£!!13tion_Card  {4I4«  4X*  6F10.0) 

Notes  Columns  Variable  Entry 


1-4  JSPLN 

5  -  B  NPTS 


( 1) 

9-12 

ITYP 

<2) 

13  -  lb 

NCALLS 

21  -  30 

SLEPT 

31  -  40 

SRIGHT 

(2) 

41  -  bO 

XI 

(2) 

51  -  6  0 

DX 

61  -  70 

XSCAL 

71  -  80  FXSCAL 


Spline  function  number;  1 » 2 » . . . »N SP LN 
Number  of  date  points  in  this  saline 
function 

EG-.O;  NPTS  pairs  of  f(Xi)*s  and  xi»s 
are  provided  on'b  cards 

EQ.i;  NPTS  f{Xi)»s  are  provided  on  p 
cards;  xi  is  taken  constant 
GF.i;  The  maximum  number  of  arguments 
that  could  be  assigned  to  this  function 
Slope  at  the  left  end  of  the  function  ' 
Slope  at  the  right  end  of  the  function 
Starting  value  for  X.  Applicable  only 
when  ITYP.EQ.l 

Sample  interval  for  X.  Applicable  only 
when  ITYP.ES.l 

Scale  factor  of  SLEFTt  SRIGHT»  Xl»  DX» 

and  X.  Default  value  is  1.0 

slept  =  SLEFT/XSCAL 

SLIGHT  =  SRIGHT/XSCAL 

XI  =  Xl^XSCAL 

DX  =  DX*XSCAL 

X  =  X*XSCAL 

Scale  factor  on  SLFFT»  SRIGHTt  and  FX. 

Default  value  is  1»0 

SLEPT  =  SLEFT*FXSCAL 

SRIGHT  =  SRIGHT*FXSCAL 

FX  =  FX*FXSCAL 


b.  S£l,j[ne_Fun£t,2on_na^a_£wh en_I.T YP._UQ iO.).  (REID.D) 


Co  Lumns 

Variable 

Entry 

1  - 

10 

X 

xi 

11  - 

2  0 

FX 

f  <  xi  ) 

21  - 

3  0 

X 

X  i  + 1 

31  - 

40 

FX 

f ( xi  +  1 ) 

41  - 

5  0 

X 

X  i  +  2 

51  - 

60 

FX 

f  f  x1-*-2> 

61  - 

7  0 

y 

X  i  +  5 

71  - 

80 

FX 

f  f xi+3) 

(1) 


Spline  Function  Data  (when  ITYP»E3»1)  (FEIO.G 


Notes 

Co  luTins 

Variable 

Entry 

(2) 

1 

- 

10 

FX 

f  (xi) 

11 

- 

2D 

FX 

f  (xi  +  1) 

21 

- 

3  0 

FX 

f ( xi+2) 

31 

- 

40 

FX 

f  (xi+3> 

41 

- 

5(1 

FX 

f  (  X  i  ■*•4  ) 

51 

- 

60 

FX 

f  (  X  i  ♦  5  ) 

61 

- 

7  0 

FX 

f  (  X  i  +  6) 

71 

- 

80 

FX 

f ( xi+7) 

148 


f 


NOTES 


tl)  When  ITYP  is  set  to  zero  on  card  a»  NPTS  pairs  of  data  points  should 

be  supplied  on  (NPTS+3)/4  b  cards.  Pairs  of  xi  and  f<xi)  should  be 

entered  consecutively  for  i  =  1*...»NpTS. 

(2)  When  ITYP  is  set  to  one  on  card  a*  NPTS  data  points  should  be 

supplied  on  (NPTS+7)/8  b  cards.  The  data  should  be  taken  for 

coiistant  intervals.  f<xi)*s  should  be  entered  consecutively  for  i 
=  1»...*NPTS.  It  should  be  noted  that  xl  is  set  equal  to  XI  (card 
a)»  x2  =  XI  DX*  x3  =  X2  *■  OX  and  so  on. 


1 


149 

XVI.  END  COMMAND 
ld§Qi.iii£C_£^£^  (A4) 

Notes  Columns  Variable  Entry 

V' 

(1)  1-3  HEADER  END 


NOTES 

(1)  An  END  card  indicates  the  end  of  input  data  for  a  given  model. 
Following  an  END  card  more  sets  of  data  cards  for  other  models  may  be 
siipolied  to  the  program. 
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